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VOLUME IV, SUPPLEMENTARY DOCUMENTATION 


Harold P. Frisch 


ABSTRACT 

Volumes I, II and III contain the complete documentation for the program 
DISCOS distributed through Computer Software Management and Information 
Center (COSMIC). Since the time of original release, several additions have been 
made to the program. These provide an added measure of user convenience and 
versatility, and enhance computational speed and accuracy. Furthermore, a 
complete set of twelve demonstration problems has been run with the updated 
version (referred to as DISCOS2), and the output has been generated in a form 
convenient for distribution to potential users. This volume briefly defines the 
additions made to the original version. 
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A DIGITAL COMPUTER PROGRAM FOR THE 
DYNAMIC INTERACTION SIMULATION OF 
CONTROLS AND STRUCTURE (DISCOS) 


INTRODUCTION 

The original purpose of this volume was to effectively reproduce and add to the contents of Volume 
III which is distributed via COSMIC. Time constraints have made this impossible; consequently, this 
volume draws heavily from Volume III and provides only supplemental comments where applicable. 
Demonstration problem 12 (not in Volume IF) is defined, and a few brief remarks are made per- 
taining to the new subroutines. 

As with .he work contained in Volumes I, II, and III, a preponderance of the theoretical work is 
a direct result of the research efforts of Carl S. Bodley of the Martin Marietta Corporation. 

1. DEMONSTRATION PROBLEMS 

1 . 1 DEFINITION AND FORMAT 

All Demonstration (DEMO) problems, with the exception of DEMO problem No. 12, are defined in 
Volume III. These problems have been rerun with the new DISCOS2 program and crosschecked 
with the results obtained via the original DISCOS program. 

For distribution purposes a DEMO problem output tape has been created. It has the following 
format: 

• File 1; 

A listing of all default subroutines used for DEMO problems 1 through 1 2. In 
the JCL deck the object files for these subroutines are contained in DISKLIB 
DSN=NFHPF.DISCOS2. DEMO .DEFAULT. In each of the DEMO problems, 
source decks are read in which override one or more of these routines. 

• File 2: 

A listing of the complete input deck used at NASA/GSFC to run DEMO problem 
No 1 , followed directly by a complete listing of all line printer output. 

• File 3 through 13: 

A listing of the complete input deck for DEMO problems 2 through 1 2, followed 
directly by a complete listing of all line printer output. 

A partial listing of this DEMO tape can be found in the microfiche section of this volume. It con- 
tains the first thousand lines of data in each of the thirteen files. (If not attached, the microfiche 
is available through COSMIC, the University of Georgia, Athens, Georgia 30601.) 
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Many of these DEMO problems have exercised the DISCOS plot capability. A complete set of all 
generated plots can also be found in the microfiche section. 

1.: RERUNNING DEMO PROBLEMS 

The following comments pertain to the rerunning of all DEMO problems: 

1 2.1 DEMO Problems 1 , 2. 3, 4, 5. and 7 

DEMO problems 1 , 2, 3, 4, 5, and 7 are in near-perfect agreement. Minor deviations in numerical 
magnitude of integrated quantities are explained by recognizing that an upgrade numerical inte- 
gration subroutine is used in DISCOS2. 

1.2.2 DEMO Problem No. 6 

For DE MO problem No. 6, a one-for-one crosscheck with data in Volume III is not possible. The 
algorithm ETNDU used to generate Volume III data has been changed. Now the algorithm is biased 
to choose a set of independent state variables which more closely correspond to the set that the 
analyst would normally choose based on physical interpretation considerations. However, the 
net results for this problem agree with those published in Volume III. 

1.2.3 DEMO Problem No. 8 

In the case of DEMO problem No. 8, some minor changing of output format for all frequency 
domain studies has been introduced into DYNS40 and associated subroutines. Results obtained 
agree perfectly with those obtained via DISCOS and provided in Volume III. 

1.2.4 DEMO Emblem No. 9 

DEMO problem No. 9 has been, by far, the most difficult to numerically solve. Poles and zeros 
are very close and there is a several order of magnitude spread in system frequencies along with 
numerous system roots equal to zero. Determination of transfer function zeros has been the crux 
of the problem because the highest roots of the .-ystem are numerically near or beyond infinity. 

To choose the best zero finding technique for DISC02, the following methods have been coded and 
tested: those of Brockett (Reference 1), Sandberg and So (Reference 2), Kaufman (Reference 3), 
Davison (Reference 4), the original DISCOS routine (Reference 5), and a routine analogous to 
original DISCOS but with improved eiginanalysis and matrix inversion capability. For numerically 
simple problems, all methods gave identical results. For DE'MO No, 9. they all failed in varying 
degrees. 

In essence, each method is required to pick either a very large or a very small number. This chosen 
number is then used as a measure for determining the o:\ler of the numerator polynomial. When 
the zeros of the polynomial are a large magnitude, it becomes numerically difficult to distinguish 
between a zero and a root at infinity. For DFMO No. 9, the method now in DISCOS2 did the 


best job. The improved eiginanalysis and inversion routines seem to have added a measure oi numer- 
ical error control which makes it superior to the original DISCOS method and tar superior to the 
other methods tested. 

Another problem with DEMO No. 9 was the fact that certain zeros and poles were approximately 
equal. For different choices in tolerance factors, these may or may not cancel. 

While DEMO problem No. 9 has proven to be extremely difficult to handle numerically, it lias 
proven to be an excellent problem for forcing the incorporation of first class numerical techniques. 

1.2.5 DEMO Problem No. 10 

In D1MO problem No. 10 (as in No. 6) FINDU picks a different set of independent slate variables. 
However, plotted output data for particular variables agree. 

1.2.6 DEMO Problem No. 11 

As with DEMO No. 8, there is minor output data format change from Volume III for problem 
No. 1 1. However, the results agree. 

1.2.7 DEMONo. 1 2, Appendage Deployment Example 

The purpose of DEMO problem No. 12 is to show the methodology used to implement an append- 
age deployment problem from initial release through lockup. This is one of the more dilficult 
problems to numerically simulate because the total number of system independent degrees oi 
freedom can change each time an appendage hinge release or latch condition is computed. 

The problem to be simulated is a simplification of one studied for the SC’ATHA satellite. It con- 
sists of a nonsymmetrical central rigid body with two unequal folded two-segment experiment 
booms. The spacecraft spins and it is important to determine system attitude dynamics during the 
entire boom deployment/latch sequence. 

1.3 CONFIGURATION DESCRIPTION, DEMO No. 12 

A simplified model of the SCATHA spacecraft with the two booms partially deployed is shown in 
figure 1. 
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Figure 1. Partially Deployed SCATHA Model 

The relative orientation of all body fixed reference frames in the fully deployed state is shown in 
figure 2. 



Figure 2. F ully Deployed SCATHA Model. Relative Orientation of Body Fixed Reference Frames 

All body mass and inertia data is provided in fable 1 and all lunge point location data is provided 
m 'Fable 2. Vector and tensor components are relative to their respective body fixed reference 
frame and are in the inch-pound-second system of units. The body 2 and body 4 fixed reference 
frames are rotated 57.0939° and 237.()9.to' respectively from the body 1 fixed reference about 
the X, axis. The body 3 and body 5 reference frames are parallel to the body 2 and body 4 frames 
respectively. 
















1.4 INITIAL CONDITIONS. DI-'MO No. 12 


Tin* body 1 fixed reference is assumed to have six degrees of freedom relative to an inertial refer- 
ence which is coincident with the body 1 reference frame, at time zero. Initially body 1 is spinning 
at 3.5 rpm about the +X t body axis. 

One degree of rotational freedom is allowed at each shoulder hinge ( 2 and 4) and at each elbow 
hinge (3 and 5). At each hinge point, positive rotation is measured about a unit veetor in the direc- 
tion of the respective + Z body axis. Let 

0, lotational angle at shoulder hinge 2 for SC2-1 boom 

0 3 = rotation angle at elbow hinge 3 for SC2-1 boom 

04 = rotation angle at shoulder hinge 4 for SC2-2 boom 
0s " rotation angle at elbow hinge 5 for SC2-2 boom 

at time zero 

0,(0) = -d 1.5° 

03 ( 0 ) = + 180 ° 

04 ( 0) = -hi. 5° 

0 S (O) = + 1 80° 

ami all lespeelive rates ale /ero. 

1.5 CONSTRAINT CONDITIONS, SI’RINO AND DAMIMNCi TOROlll'S. 1)1 MO No. 12 

The deployment/latch sequence at each shoulder hinge (2 and 4) is simulated by a rheonomie 
condition of constraint: specifically, a fixed constraint is in effect prior to shoulder release and, 
after the latching condition, is satisfied. During the period of deployment, the single axis angular 
motion at each shoulder hinge is free and subject only to spring and damping torques. 

The deployment/latch sequence at each elbow hinge ( 1 and 3) is simulated by a nonlinear spring 
effect. The nonanear spring attempts to model the spring powered deployment up to latching 
and then to model the dynamics of first mode boom flexibility after latching. 

1.5.1 Nonlinear Spring Torque During Deployment: 

During deployment, the net spring torque at each hinge is the result of two distinct effects: a 
power spring mechanism designed to ensure proper deployment, and the nonlinear elastic char- 
acteristics of the experiment wire bundle contained in each boom. 
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Let 


0 I a | = deployment angle at hinge point i+1 (degrees) 

1 2nr 

Then the equations used to define the spring torque associated with the power springs are: 

• Shoulder hinge power spring toique (i = 1,3): 

IPW, - 3.0 * (.5860 + .01 0 >) 

• hlbow hinge power spring torque (i = 2, 4): 

TPWj =3.0 * ( 2.9333 + .01 0 { ) 

The spring torque associated with the wire bundle in each boom bent at the hinge points must be 
determined via experimentation. As a first approximation, the following equations are used: 


• Shoulder hinge, wire bundle spring torque (i = 1 . 3): 


THNj 


1.2 * 2.81 
00 


0 

I 


• l.lbow lunge, wire bundle spring torque (i = 2, 4): 


r 


.8 * ( 


.44 + 


1.68 

~40°' ] 


0 < G i <34.24° 


.2 * ( 1.44+ - 1 — -fl ) 34.24°< 0 
40 1 1 


40° 


TBNj - 


1.2 - (.24+ --(G. - 40)( 40° < 0 <80° 

40 1 

2 47 

'.2 * [l.lo 2 * 4 (°i ~ &0)J «0° < 180° 


1.5.2 Nonlinear Spree Torque for Partially Deployed Case 

If a hinge has latched, the elastic characteristics of the situation are changed. The problem no longer 
is a deployment problem but an elastic vibration problem, and the constants of the system must be 
adjusted accordingly: 


I I Ih = 1450. * 0, 


• Shoulder hinge latched (i = 1.3): 


• Elbow hinge latched (i = 2, 4) with associated shoulder hinge also latched: 

TLT, ■ 105. * e i 

• Elbow hinge latched (i = 2, 4) with associated shoulder hinge not latched: 

TIT, = 25(» * 0, 

• Rhenomic Constraint Conditions at Shoulder Hinge (i = 1 , 3): 

Deployment design conditions must be simulated: these dictate that the shoulder 
hinge will be restrained until the respective elbow hinge deployment has proceeded 
through an angle of 22.4°. 

Shoulder hinge deployment can proceed after this point; however, there is a hard 
stop which prevents the shoulder angle from becoming less than -91.5° and 
physical considerations dictate that even though deployment is possible, it will 
not take place if the constraint torque is positive. Each of these conditions are 
checked in subroutine SET I. It should be noted that latching in the present 
context does not imply that motion is totally restrained: it implies a change 
in stiffness characteristics from a spring deployment to an elastic vibration 
situation. 

• Damping torque during and after deployment: 

During deployment, damping torques will be assumed to be negligible so that 
a worse case situation can be studied. After latching viscous damping will be 
assumed and taken to be: 

(1) 12.5 in lbs sec/rad for shoulder hinges and 

(2) 5.5 in lbs sec/rad for elbow hinges. 

All other damping effects will be assumed negligible and ignored. 
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2. IMPROVFD C APABILITY 


2.1 DFl 6 SUBROUTINE 

Continuing with the practice of putting the greater bulk ol the documentation into the DISCOS 
source file, subroutine DFFft has been written and included in DISCOS2. A copy of this routine is 
shown in Appendix 1. Theoretical background along with guides for user implementation are 
included in this subroutine. 

2 2 RANDOM COMMHNT TOR ANALYSTS 

• 1 igcnvecloi compulation, subroutine FIGAVV sets up the calling sequence 
lor the computation id all eigenvalues and eigenvectors trf a real nonsymmetric 
matrix. In general, the system matrix will be both defective and derogatory, i.e., 
there will lie repeated roots and a lull set of linearly independent eigenvectors 
will not exist. The F. ISP AC routines do not recognb.e this and hence blindly 
generate a full set of eigenvectors. The eigenvectors which contain extremely 
large numbers are the ones which are linearly dependent upon others. Since 
eigenvectors are only used herein as a data interpretation aid, no attempt is 
made to compute eigenvectors of grade greater than one. For further comments, 
see References ft and 7. 


• I )on t expect a one-tor-one exact crosscheck lor DFMO No. d. There are several 
sections of i he output which arc extiemclv sensitive to machine precision. 

• flic FISPAC eigen. inalv sis routines contain a machine precision number 
MACIIFP = 2 ‘ 5 2 . I bis should be changed if the machine is not IBM-360. 

• Higenvectors are used to provide a measure of how much each state variable 
contributes to the system response at the associated eigenfrequency. 

• Please call II. P. Frisch NASA/GSFC if you find any programming bugs or 
if you are hav ing implementation problems. 

• Don't change the numerical integration algorithm unless you thoroughly 
understand logit used in implementing unilateral constraints. 

• Subroutine UNI- AR has two "small numbers.” FPS1 and FPS2. defined via a 
DATA statement These are used in the algorithm as a test for convergence. 

To date these values have worked satisfactorily in all applications; however, it 
would be better if these small numbers could be made to be functions of the 
machine precision number MAC'HFP used in the FISPAC routines. 
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c 

C SUBROUTINE ASQR DEBUG # I1B 

C CHANGES 

C (DELETED FROM DISCOS-?) 

C REASON 

C E IGENANALYSI S NOW DONE VIA FISPAC ROUTINES 

C 

C + ’F’F’F^MM#************************************************^************** 

c 

C SUBROUTINE ASIMIR DEBUG « *5 

C CHANGES 

C REDIHENSION CODE <*RS ADDFO for /i OERUG/ 

C 

C$$***>4‘>i‘’i'$**********************************ee*e<i VI 9ejt*e*9£*:p**ip*****^*$* 

c 

C SUBROUTINE BAKSLV DEBUG # 5? 

C CHANGES 

C REDIMENSION CODE 4 R 5 ADDED FOR /I.DFB1JG/ 

C 

C>!‘ , (' ) !‘’f <1 fc>t‘>!<#’t<**>l'*******************************************l i l**********r | t**** 

c 

SUBROUTINE RAI.ANC DEBUG » HI 

FIGFNANAI.YSIS - FISPAC 


C 

c 

C CALLS 

C 

C CALLED BY 

C 
C 

C PURPOSE 

C 
C 
C 
C 

C>>“<‘* , ! t, ! t> !"i <J <‘ 1 * 1 <“l‘>!<>M I >)‘**>t<********************** ******************* ft*********** 

c 

SUBROUTINE HALRAK DFBUG H 13B 

r IGF-NANAI. YS I s - FISPAC 


NONE 

EIGAVV 
F IGVAL 

6ISPAC ROUTINE TO BALANCE A REAL MATRIX AND 
ISOLATE EIGENVALUES RY ROW AND COLUMN PERMUTATIONS 
WHENEVER POSSIRLF 


CALLS 
CALLED BY 
PURPOSE 


NONE 

EIGAVV 

FISPAC ROUTINE TO RACK TRANSFORM THE F IGFNVFC TORS OF 
THAT REAL MATRIX TRANSFORMED RV BALA'-'C 


A-3 


i 


f 

C SHB«ni|T INK HOUT'IP DFHUG a c 1 

(' f h A M i > F F 

n phi i tn -.Fii'N c.iint 4 HF AnnFn for /i.npmir,/ 

r 


C SlIHKflll T IMF nHliPNR flP HIJIi H 4S 

( ( t|AMl,| S 

0 w t- • 1 1 mi m s i ,in [ ,tni 4 n‘. Amu-i) mu /i.nmou,/ 

c 

C 

C SUBROUTINE rtSOENR DFHUG « 47 

( C.HflMGFS 

khi i mhms i on conF 4F 5 AnnFn F|i« /i.nFMir,/ 

r 


_ ■ ■ V k ik Ik * ~t vt V V 1* £ -fr kt >k ik Ik : k ik Xt * Ik xt ik tt ik *t ik Ik Ik 'k Ik kt Ik >k Ik M 5k >k V V Ik >k Ik lit Ik Ik Ik :,t A ik -l ;,t V Ik lit -t V V Ik Ik l,t lit ik 1,1 It It ;,t :,t 


c 


( 

r 

C 

r 

C 

c 

c 

r 

c 

c 


SimmiUT IMF CliMPlM 
CAU.S 

MULTAH 

SK Fk VB 
MIJL T 3 

MAOn BY 

YP.)T 

PUR PftSF 


0 FH 1 K, a 1?4 

MAIM I. f * F 0 P p F A T P I* 


H T A R A 
FI ON l 
W« I r K 


TI) C 0 v pi II F T ( I T A 1 . FYFTFM f FMTPW IF MAFF I UFA I I UU 
A ,ri IMPPTIA T^NFOR PFI.ATIVr TO ThF F V S T f m CM, wu] 
TNF IMFRTIAI. PRAMF. A! FO TO FIMli PR I Mf. I PA I. R|;MFMTi> 
i )F P'FPTIA ANTI AFFPCIATFn R^T AT I n N T R A' FFPR V A T I r '^ . 
REFliTF FTORFn IN /r.OMPftS/ FOP PVFNTllAI mTDIIT 


I'J PRMTMJ 


C 

f * i*k 4 t)t ** 1* At lit * >* ill X* & *t »St lU Ik x. >;t lit l.t tit ik :1 Ik lit A It 1,1 kt V A lit lit 1* v lit l|t V i.t V i;t l,t l.t A lit -k 1/ lit 1 V i.t A l,t 1,. $ -,t 1,; lit lit i,t 1.1 i.t 1,1 i,t i;t i,i 

r 


r 

r 

C 

r 


SUBROUTINE 0 RFT 3 
C *-> AM. ' -F S 


p c n I y T N S I 1 1 m 


nmiif. a 1 ? 

C ing 4 PS AnnFn FOP 


/i.nFHtir,/ 


C ^t 1 1 a . a m <- a i^ <t * ik * « i> ijr ik -;t v a a > ... > ik r- 1;. ik ik i; v a nt * in * ijt ik M >k ‘f * >k 4 * ik v ik ■- -k a >s i:s St w » >k ik ik « i.t w « i,t :k ,t ik ;;t ik ik 

C 
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ooOo°oorsOnOoOriOooof>oooooOoooooooOoor)C~'oOof 1 oOoo 


SUBRDUT I N6 
CHANGES 


DEORMB DEBUG 

RE D I MENS I ON CODE ABB 


« BO 

AnnFn fur /ldebug/ 




SUBROUTINE DLMBRT DEBUG « 1 ?0 

USER OFF INFO SUBROUTINE 


CALLS 

(NONE UNLESS USFR REQUESTED) 

CALLED BY 

YDOT 

(ANY REQUIRED BY USFR) 

PURPOSE 

TO PROVIDE THE CAPABILITY TO COMPUTE ATTITUDE 
DYNAMICS RELATIVE TD AM ACCFLER AT IMG REFERENCE 
POINT. THIS CAPABILITY RFOUJRFD TD CIRCUMVENT 
NUMERICAL PROBLEMS. DLMBRT ASSUMES THAT Th- n*ir;p! 
OF TH P-FRAME AT HINGE POINT 1 IS THF COMPOSITE 
SYSTEM CENTER OF MASS AND THAT ITS MOT ION H F I. A T I VF 
TO A TRUE INERTIAL REFERENCE IS USFR DE E I NADI. F 
EITHER IN CLOSED FORM OR VIA I NTFGFR AT I ON OF ITS 
EQUATIONS OF MOTION 

REASON 

TO AVOID THE STANDARD NUMERICAL COMPUTATION PRfinLFMS 
ASSOCIATED WITH ADDITION AND SUBTRACTION DF I 6RGF 
AND SMALL NUMBERS IT IS OFTEN DES I R AHLF TO DFFINF 
SYSTEM ATTITUDE DYNAMICS RELATIVE TO AN ACCELERATING 
FRAME OF REFERENCE. 


THIS PROBLEM USUALLY OCCURS WHEN THE SYSTEM IS ACTFU 
UPON BY A UNIDIRECTIONAL EXTERNAL FORCE FILM) AND 
THE PRIMARY GOAL OF THF SIMULATION IS THF ASSESSMFUl 
OF ATTITUOE DYNAMICS, RATHFR THAN TRAN St. AT I OF A L 
DYNAMICS 


#■»>(< 

#*** USER CODEING RULES AND MODELLING CONSIDERATION 


THE DISCOS FORMALISM IS BASED UPON A LAGRANGF FORMULATION 
OF THE E OU AT IONS OF MOTION. INHERENT IN THF OFVFLUPFMfmT 
IS THE DEFINITION THAT BOTH LINEAR AMD ANGULAR VELOCITIES 
ARE MEASURED RELATIVE TO AN INEHTULLY FIXED R c F F R e Ml. e . 



A-5 


thf location gi- thf c.ompositf sy<tfm r ff. t i- k or mas;. 

CANNOT ALWAYS HF TAKFN TO B F NEAR THE INPUT I A t RFFFRFEoE. 
THE LOCATION IS niCTATFO BY THF SIMULATION RE OM I u ,‘F" I S . 
IN SOME CASES The INFMIAI. PRIME MUST «F AT A f.PAVITY 
SOURCE, IN OTHER CASES LARGE RFSOITANT PxTERpAi. F'iUCES 
PRODUCE LARuR RELATIVE 0 I S PL AC PM p mj S whICH MAV OR MA. V M'l 
BF IMPORTANT TIi MONITOR. 

IF THE I N R H T I A I IR I M N is OR HFC'iORS I AR K I Ml V *- 1 ’ 'ROM ll-u 
SYSTFM C E N T I R Of MASS NUMERICAL PROBLEMS C. AT' BE 
ENCOUNTERED; ThrSF PROBLEMS A R F JMhFRFNT I A 1 D|i,|TAi 
C 0 M RU T A T I O' WHENEVER VFRY LARi'F AND V C R Y S M ALL 
MUST IF A C C 1 1 R A T e [ v KNOWN DIJRIfr; C. !MPUT AT ION. 


RrOC F-DORf 

1) COMPUTF THE resultant c xtfpnal 

SYSTEM. 


FORCE AC T I k, o 


IF The MOTION OF THF SYSTEM fENTER of mass « e I h I I v e 
to THf INFRIIAL REPFufmCF is IMPORTANT SET OR Them 
f ou a t Ions fur integration via subroutine control,, 
f k e i j o i NT L Y Three are THE ORBIT FDoaTIOve 



B I 

RESOLVE 

Top resort A* t 

force vfctor intp 

THE P— E R A M e 

r 


REFFrEN 1- 

i associated 

WITH H I N T> 

,E POINT 

I , 

or r | M 

1 


V 1 11 = 

* — r 1 1 lo of R 1 T 

I’L Force 

v 1 c 1 1 1 r 

nr r 

R- F r A 0 • 

i 



At H | '|I,E 

POINT I 




r. 


VIP) =" 

Y -Cl U‘P' IE r A T 

[IF F'li-Ct 

VFC TOR 

t-'RT 

r-era’i; 

r 



AT h I M; F 

POINT 1 




C 


V ( B ) - 

/-COMPONENT 

f F FORCE 

VFCTOR 

W« T 

P-FRA.. E 

C 

r 



AT HfNGE 

R ' I A'T 1 




\r 

c 

4 ) 

RESOLVE 

E ( : R C F VECTOR 

INTO BODY 

F I XFD 

r.l f'RD P AT S Aor 


FACh MOOY AS EUI.I ows: 


R E A i. » B R V ( B ) , V ( B ) 

Compote TOTAI mans 
AMT = o.o 
no 1 N ~ 1 « N R 

1 AMT = AMT + AMU(S,4,N) 


TRA^seorm force VECTOR TO E>flOY COORDINATES, 
COMPOTE APPARENT EUkCF EFFECTS, 


<~>oOo^oOoOoor^f^oOo^oOoOo^oOoOoOoOoQo ri r'r , '*o r " , c"jOr"jOo <" 1 


c Arm m tordup array 

no 2 N-l.NB 

rtV(l) * ROL( If l.NI*V( 1) + KOL ( 2 * 1 • N ) * V( ? ) + RDH 3 , 1 1 N > « V ( 3 ) 

HV(2) * KOI ( 1,2.N)*VU > •*■ ROL(?.?*N)*V(?) + ROL ( 3 , ? . V » *V ( 3 ) 

B'/m - ROLI l.3,N»*V< 1) + R0L(?.3iN)«V(?) + RDI. ( 3 . 3 1 N ) * V ( 3 ) 

C GET STARTING LDCAT I UN IN T (lk r UF ARRAY FOR Rfinv N 

i.OC » LOOU(N) 

f. APPARENT TUROIIE ON H()DY N 

f.lMir, ) * i,(i nr » 

* -(AMU( | ,‘.,N)*HV( >) ♦ AMIMI , 'nN'l ) )/A'.. I 

Muir.+ i) * Mi.nr-fi) 

* -< AMU(?.4,N)«RV( 1 ) + A Mi j ( 3) ) / A” T 

G((.Q».*?I - GILOC+2) 

* -(AMU(3,4,N)*HVi II + AMUI 3, B,N ) YRV( ? ) )/ AMT 

r, arrarfnt force on body n 

MLOC + 3) « MI.OC+3I - AMU( 4, 4, N) -‘HYMI /AMT 
MLOO + 4) * t, (1.004) - AMIK4.4, N) VKV( /) /AMT 
ML0O5) * GILOC+SI - AMU(4,4 t N»MRV(?)/AMT 
C APPARENT MODAL FORCE ON MODFS OF RUDY M 

JF( IRCFI. X(N).FO.O) CO TO ? 

Oil 3 K«l, IRGFLX(N) 

G(LOC+B+K) = GILOC+B+K) 

* -( AMU(4,G+K.N)*RV< 1 ) * 

* AMtJI 5 .fc + K.N )*RV( ? ) + 

* AMU( 4.B+K , N )*RV( 3 ) ) / AMT 
3 CONTINUE 

? CONTINUE 
RETURN 


■3 ) NOTF THAT IT IS IMMATFRIAI. WHERE THE FORCE VFCTOtt 
(VI 1)»V(2>.V(3) ) IS COMPUTED. IT CAN M F COMPUTED 
HEREIN OR IN SUHROUTINF CONTRL . WHICH E VF R IS “nST 
CONVIENENT FOR THE USFR 




SUBROUTINE DYNS10 DEBUG * ? 

CHANGES 

IF INPUT DATA CODE • N Y T P F * = 3 CALL MODALN('i) 

REFER TO 

DEE 3 DEFINITION OF DYNS 10 INPUT DATA R F A n STATEMENTS 


’ll*## 


DATA INPUT MODIFICATIONS 


##V 

#### 
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*** 


vvv 


c 

f. 

r; 

c 

c 

c 

c 

r 

t 

c 


1) last Xf-AD staTFMFNT heaps htfr.FH rnn>- mtvmc, Mf m- 

I F ( \TYPF. FO. T) TAI.L MI'PAI.NIN) 

AnnE'i tci riYNSin 

?) CALL K(Af> (IMPATA, 1, 1, 1, H) 

NEW DEFINITION! 


( 

r. 

I 

I 

(, 

I 

r. 

r 

r 


1 1- ( T Ml) A T A ( ) . |. T . 0 ) V A x | A *< | F S T F I' xilMrF KH1IA 

! MTt-r.W AT I f l‘J KITH Sill' S|/' 
pFiTAT(NAx) - AM‘,( TS'i'A I/i ( / ) ) 

I F 11 M|)a T a ( / ) . I,T . 0 ) Finn STEM XUNIM MlTIA 

l A'T F C,H A T I OF' WITH X |F|< >. I /l 
FIF UT AT = T M n A T A ( ?) 

0 ) !. At. i. x F AT' ( |»'V , 1 , 4, ] , Fi 


C 

i 

i. 

C 

C 

r 

C 

i; 

r. 

c 

r. 

r 

r. 

r. 

r 

r 

r 

c 

r 

r. 

C 

c 

r. 

i 


VFCT IX Xl/F 1 hv 4 FOX C.WAVITV NMAnl FK, T pin T A 
This h A T A ''AN Xf DPPATIP AMP MAPf TI Mt - iiti.tr : *«- i 
VIA IMF HP SI'HXni'T IMF fiaw l f 

lx ( will - wvi?) * wvi") = n,r> i njsr s-? 

ASSIlfFS f.x AVI T Y r,pA1IFNT tFFFn N'F|;i J r, I h I F 
A\P SI , x 1 1 1 ) T | F HwhIT V- 1 1. r. ■HIT «F r ALI.FP 
V I A i",P VN« P 

X F A Si IN 

1) AT T I M i s IT IS NUT NECESSARY FOR AFCHPAT- S I i 1 L A T 1 1 ' * 

T I J I X' P ' i T A Mill MNITF FI FMU'T FIFx|i,(|. ni’iHY ‘•‘ll'iFI., 

’■'( 1 P Al M will x I a p IN OM Y I I x S T ' IX IH x f I ( y I HI I n ' ' ' Y 
■•Mini.. ' A I A XM'IJlXMi 1 1 X! I A M. Y AVAp.AiM.f- wITMlUT 
T i mi ir n T x i 1 1 - | F 

?) I NT fc l-x A T r M RACKAF.F IN oisrns-? HAS VARIAM.F STEP 

C A P A x 1 1 . I T Y . APAPS PX F P I F. T I IP / F : ’X X >- C T OP C<»PAx|IITY 

OF PISI.iOS PFMpVFn KFFAIJSF IT WAS ‘T V^x ||XFH nvn 
A xlf.'-.F K’lTTA VAX I apl f STEP POUTIMF WITh CFXTIrM 
UNjf'.iF- CHARACTERISTICS WAS MfFi)F'i FOR 1 1 S’ I I. A T f a A I. 
CONSTRAINT FAPAPII. itv 

0 ) P x r i.; - I, I- I Ft ix CC.iPPUT I NI- MRAVITv '.RAPIF''T EFFECTS 
IF’HN A i.i.iisTEx OF CPUPI F "f FI.fx i x|. E HlTM IF S wAs 
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f 


I 

l 

I 


C LIMITED IN Appi If ARIL I TY IN UlSOnS 

c 

C. mw siiMwimT |mf dkvuro r A l is surrpiiT INE uri*|T mi> 

l'. A OH I N I N ON OF IIKH I r ri IW 1 1. 1 NAI I V Ml 

C ri Y AriMVE READ STATEMENT. N . iv>. I E* T I C OrHITS A \0 

C clusters of criupi fo EI'*M 1 ‘ wnii', TAN roiitinhy 

C riE ANALY 7 En wITh MINIMA! USE- !NT r REACF 

r 

f. 

C SUrtKf HJT INE OVNS?n npmif « 57 

C CHANCE 

C COMMON /uprkTA/ DELETEn 

C COMPUTATION TO (DAD ARRAYS I *' /dppkTA/ rn Ufa 

C REASON 

C IN DISCOS-? THE NEW V C RSIDN OE SOHRrurivF PK«r.«>' 

C DUES NOT R EOU I R F THE STORACF AREA RiSCRvlP r. v 

C /OPRkIA/ 

r 

(, * V w v *X V X< V A l!* WW A * *' <1 W * * fci V & V x< ** V * * P W K' V« v V M W ^ ; V w v * Xi* V *■ *•.< - f v >. [ R ** 

c. 

C SUriRI IP T INE DYNSAO ME R U< ■ «*A 

C M A I N I. I MR ipt Pu I I 

C CALLS (Nr W) 

C OPNC.H 

C r I OVAL 

C FIOAVV 

C C H AN Or S 

C 1 ) CALL TO PUNCH ADDED SO THAT ThF SYSTEM 

C CHARACTER! STIC MATRIX A 1 fl M C WITH FAC.H tRAMSEFw 

c function character 1 st ic matrix Aon r n i.uMn. of inpoi 

C SIOANL CnEEEICIFNTS CAN RE PUMCHcn Fnu H|i.>u-r , 

C INDEPENDENT ANALYSIS 

r 

C «*>t 

C ##«* DAT A INPUT MODIF [CATION v*w* 

C w# 

C 

C FIRST RFAD IN 0 YN SAD CHANCED TO 

C 

C KEADINIT, FORMAT = R A A ) I.NAM, i.PP'Ch 

C LN AM = (NO CHANCE) 

C LRNCh = AHPNCH IE so. PUNCH SYSTEM AND TRANSFER 

C FUNCTION D H A R A C T R S I T I C MATRICES 

C IE MOT, NO ACT I DM TAKE' 1 


i 



’!Onnnf'o^onoOo^ r '^n* n ' > nnnnf^n^o^oOo*^onn 


4 


I 


2) SHIFT CONSTANT FOK 7EHO FUNDING ALGORITHM |N N1IMS 
IS NOW SUBJECT TO INPUT CONTROL, IF nFSlRFO 

*#¥ *** 

#*#* DATA input modification ***** 

*** *** 

THlRQ READ IN DYNSAO C.HANRFD TD 

CALL READIMI IRY,A,NCYf.,A,KR ) 

IKYU.J) - (NO CHANCE ) 

I KY ( ? » J ) - (NO CHANGE) 

I R Y ( 3 , J ) - (NO CHANGF ) 

(NFW) IRY(A.J) = SHIFT CONSTANT FOR NUNS SFT TO YIMlS 

SOUAKI H til 1 1 HI I NP> i | 

l)F t- AIM. I ! 

com « -nsoKT o.nno) 

OTHRRW! S5 s 

CUN * -nSORT(l.«no*IPYtA,.M ) 


f 


c 

c 

c 

C 

C 

c 

c 

C 

c 

c 


3) REPLACE CALLS TO OLD 'F I RFNANAL YS I S ROUTINES 
U R n R V R ANn FJDVFC 

WITH CALLS T(1 THE FISPAC F I fiF N AN Al_ Y S 1 S ROIIT1NFS 

RF A SUN 

FISPAC ROUTINFS AP F CONSJOPRFO TO HF STATF- OF TUT 
AWI, WHTHIAS URlUINAI 0 1 sens POUT INfS Apt AOriiUMI 
I'll Y Oil NHl (.IlNIAIN AS NIK II MlM! P K.AI IP‘.'|>r 
C.IIN 1 wol I or, | (. IF I w F | u fi'Pi [Ot, 

ALSO 

FIOAVV COMPIJTFS AI.L F 1 0 FNVEC TOP S WHFRPAS FIDVFC 
COMPIJT F 0 ONLY SELECTED l)MFS A NO RROKF DUNF |F 
SYSTFM HAD REPFATFn F I r, F NV A L 1 1 F S 

A) COMPIITF AMO OUTPUT ALL F lOFNVFf, TORS 

if •!< #>!<>* 

**** DATA INPUT MOOIF ICATIUM ***# 


t 


A- 10 


& 


L. 






C *** 

c 


C RF AO RANGE FOR EIGENVECTOR 

C COMPIJT AT 1IIN DELE TED. 11 IS 

C COMPUTATIONALLY MORE EFFICIENT 

C TO BLINDLY COMPUTE Al.l. DP THEM 

C 
C 


c 

c 

c 

c 

c 

c 

c 

t 

c 

c 

c 

c 

r. 

c 

c 


SUBROUTINE E I G AW 
CAULS 

BALANC 

ORTHES 

ORTRAN 

CALLED BY 

DYNSAO 


DFRIJG » 130 

FIGFNANAI.YSIS - e lb PAL 


NOR 2 
WRITE 

RALBAK 


PURPOSE 

EISPAC DRIVFR ROUTINE, To SFOIIFNT I Al t Y CALI The 
FISPAC ROUT INFS REQUIRED TO COMPUTE Al.l. E1GFNVAIIIES 
AND IJNNURMAL I / FO EIGENVECTOR 1 ; OF A hfAI. GENERAL 
MATk IX 




c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


SUBROUTINE E ION 1 


CALLS 


WRITE 


DEBUG * 125 

UTILITY, MATRIX OPERATION 


CALLED BY 

COMP IN 

PURPOSE 

TO COMPUTE THE EIGENVALUES AMD ASSOCIATED 
F I GFNVECTOR S OF ANY RFAL SYMMETRIC MATRIX USING 
METHOD OF JACOBI, THRFSHOLD VERSION WITH 
PIVOTING. COMPUTED E1GFNVALUFS AMO EIGENVECTORS 
AkE REAL 


REASON 

REQUIRED BY COMPIN TO COMPUTE SYSTEM PRINCIPAL 
MOMENTS OF INERTIA AND ASSOCIATED ROTATION 
TRANSFORMATION MATRIX 


L * # >j( « # m # He # # $ # # # *< ijc # # HC * s)c » *t # * i* lit* * # W X< # # # * # ¥ « *e Xe >je # i|e He * # *e j;e He >(e * >? *e *e ),e * >;e 


c 


A-n 


s«h rout ini f iavf c dibug * in 

CHANGES 

(flEUETFO PROM DISCOS-2) 

UFA SON 

5 I GEN ANALYST S Nnw DONF VTA P I SPAC RDIITTAPS 


C 

C SUBROUTINE FINIS T OF RUG # AA 

C CHANGES 

C BEfSIMENSUSN CODE 4R5 AIM} 60 P0« /LDpaiiW;/ 

C 

C »#* SS ##»£>» W* Si** >|t*S>t!!rW *!!**!(>*>!! 

c 

C SUBROUTINE P INDU DEBUG S 3S 

C CHANGES 

C RED! MENS I ON CODE *R5 ADDED FOR /I. OF RUG/ 

C • 

0 * $ t}e # # $ # * # # $ * a* # * * * # # sf! *e» * * !»# # * *t # $ a: # # # ft # # * * # # at at at at # * * # $ * * $ s? # » at at n* a* a* * * « * * * * # * 

C 

C SUBROUTINE GRVGRO DC RUG * 5« 

C MAIN LTNF OPEKATIUM 


CALLS 


CALLED BY 


WRITES 
MULT 3 
MUITAD 


ORBIT 


CHANGES 


CORRECTED TO PROPERLY DEFINP GRAVITY GRADIENT 


'nnnrnnnnnonnnrinnnonnn 


C 

C 

C 

C 

C 

C 

C 

C 

C 

C 

c 

c 

r. 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


FORCE AND TORCHJE ACTING UPON FACH RODY nF THF 
MUL T l-BODY SYSTEM 

THEORY 

D I SCOS-2 ASSUMES THAT AN ORBITING REFERFNCF F R A M F 
WITH ORIGIN IN THF VICINITY OF THE SPACECRAFT MASS 
CENTER IS OEFIMED. THIS RFFFRENCF FRAME I> FIXED 
INfRlIALLY IN ROTATION RUT IT'S ORIGIN 1 R A N S I A T I S . 
THE MOTION OF THE ORIGIN ANn THF OIRFCTIOM OF THI- 
GRAVITY FIELD IS DEFINE VIA SUBROUTINE ORBIT 

LET: 

GR( ) = POSITION VECTOR FROM GRAVITY SOURCE TO THF 
ORIGIN OF THE ORBITING REFERENCE 
FROM SUBROUTINE ORRIT 

GR ( ) « RCM AG* G AMG l ( ) 

DOL(N) = POSITION VECTOR FROM ORBITING RFFFRFNCF POINT 
TO THE BODY N REEFRFNf.E POINT 

GM * EARTH'S GRAVITATIONAL CONSTANT 

AMll(N) = MASS OF BODY N 

GF ( N ) = GRAVITATIONAL FORCE VFCTUR ACTING ON BODY N 

GMAG = LOCAL GRAVITATIONAL ACC FI. F R AT I ON 
FROM SUBROUTINE ORBIT 

GMAG = GM/RCMAG**? 

THEN THE GRAVITATIONAL FORCE VECTOR IS 

I GR ( ) +DOI INI) 

(>B ( N ) = -AMU ( N ) *GM* 

I GR ( 1+pnnM |«| 

EXPAND THE DENOMINATOR IN A BINOMIAL SERIES AMO RETAIL 
ONLY FIRST ORDER TERMS 

I GR ( ) +00L (Nil ** ( -3 ) 

= ( ( ( GR ( ) +DOL ( N ) ) . ( GR ( ) +00|. I N ) ) )**(-3. ()/?.()) 

=RCMAG**(-B)*< 1.0 - B . 0*GAMG I ( ) . 0 0 L ( N ) / R C M A G ) 


A- 1 3 


r. 

C SIJH ST ITUTf BACK INTO THE GRA V ! T AT ! ON At. FORCE EQUATION 

c Tn obtain 


r. 

c 

r. 

c 

c 

c 

c 

r 

C 

c 

(. 

c 

c. 

o 

r. 

c 

r. 

r. 

r 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


gfin) = -amu<N) w gmag<>(gamgi < ) ♦ not ( N ) /rcmAg 

- B.O* (GAMGI ( ) . noi ( N ) ) *gamgi ( )/rC.mAg 
+ higher order terms ) 

IN THIS EQUATIUN THE 7 ERU ORDER TERM NAMFI. Y 
-AMU(N)*-GMAG*GAMGI( ) 

COES INTO THE ORRIT EQUATION. THF GRAVITY GRADIENT FORCE 
WHICH MUST RF UTIU7FD IN SUBROUTINE GRVGRD IS 

- AMIJ ( N ) *GMAG*DOLL ( M) 

WHEkF 

DOLLIN) = (DOI.IM - 3*(GAMGI( ) . DOI. ( N > ) #G AMG I ( ))/RCNAG 


FIXES 

THE THEORETICAL DEVELOPFMENT CAN RE FIXED BY 
CONSIDERING A CLUSTER OF DEFORMABLE ROPIFS IN 
FIGURE 7 PAGF 49 AND INTRODUCING THF ORBITING 
R F E F R F N C F POINT 

IN VOL 1 SECTION F THF NET RESULTS ARF CPRRFCTFD if 
ThE ELEMENTS OF GAMMA SUR G IN FOUATIOM !!-l?0 APE 
EQUATED TO THF F L E MEN T E DF The vFCTOR DOIL(N) 
dfeined AhOVF. 

THE SUMROUTINF GRVGRD WAS FIXED BY SIMPLY USING 
THE VFCTOR DOLLIN') IN THF APPROPRIATE EQUATIONS 


C # w * * * # * * # « $ $ # v * * * $ */■ ## >u xc ■* * v * * # & «.■< * >x m >x * * * x< # * * -f # * * * * » * * # »x # >f # >f >t v # v v v >;< * >:< >;< v «' 


C 

(. SUBROUTINE LINEAR OFMUG * 40 

C CHANGFS 

C REOIMENSION CODF 4B5 ADDFD FOR /LDFRUG/ 

C 

C * & */ * ^ # >i< a $ $ v * a * >* » # $ * * * * * * # » & # * >:* >x ^ # v $ >;< * *< % u * * >> * $ # # >:< * * * >,t # ^ $ si- 


i 
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DERUG * 31 


SUBROUTINE GAUSSI 


CHANGE 
CALLS 
CALLED BY 


COMPLETELY REWRITTEN. 

WRITES 

MSMODC 

ASIMLR 

LTRESP 


UTILITY, MATRIX OPERATION 


PURPOSE 

A MODIFIED ALGORITHM FOR MATRIX INVERSION VIA GAUSS 
ELIMINATION, ALGORTHM OOFS A SEARCH FOR THE LARGFST 
POSSIBLE DIVISOR. THE I NPUTTFf) N BY N MATRIX 'A' IS 
DESTROYED DURING COMPUTATION 

REASON 


NEW METHOD FOR OBTAINING TRANSFER FUNCTION 7FROS 
DOES NOT REQUIRE GAUSSI FOR SUPPORTING COMPUTATION 
GAUSSI REWRITTEN TO REFLECT THIS AND IMPROVF 
COMPUTATION ALGORTHIM 


************************************* ft******************,),*,), 


SUBROUTINE GETBMB DEBUG * AM 

CHANGES 

RFD I MENS I ON CODE AB5 ADDFD FOR /LDFRIIG/ 


*******************£****:,.******************************,),*** I; ,**,),* 1;l , |1 **,,,,), 


SUBROUTINE HOR 
CALLS 
CALLED BY 
PURPOSE 


DERUG H 1 3 A 

EIGENANALYSIS - EISPAC 

NONE 

EIGVAL 

FISPAC ROUTINE TO DETERMINE THE EIGENVALUES OF A 
REAL UPPFR HESSENHERG MATRIX 


************************* If!*************************************,),***);, *** 


SUBROUTINE HOR2 


CALLS 


NONE 


DEBUG # 135 

EIGENANALYSIS - EISPAC 
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oOoOo< _ >or>0' - >or>or>or>ooooor>oOo< -> oooOr>ooc-)oooOoOo<->or>o 


called RY 

E IGAVV 

PURPOSE 

E ISP AC ROUTINE TO DETERMINE ALL EIGENVALUES AND 
EIGENVECTORS OF A REAL UPPER HE SSENBFRG MATRIX 




SUBROUTINE INV1NP DEBUG * 41 

CHANGES 

REDIMENSION CODE 4R5 ADDFD FOR /LDERUG/ 


SUBROUTINE LUDATF 


CALLS 
CALLED BY 


NONE 

LUINVD 


DEBUG * 137 

UTILITY, MATRIX OPFRA T I ()M 


PURPOSE 

PERFORM THE L-U DECOMPOSITION OF A RFAL GFNF»AL 
MATRIX WITH TEST FOR ALGOR I TM IC SINGULARITY IIS I MG 
THE GROUT ALGORITHM 




SUBROUTINE LUINVD 


DF BUG « 


CALLS 
CALLED BY 
PURPOSE 


UTILITY, MATRIX OPERATION 


LUDATF 

NIJMS 

TO COMPUTE FOR A REAL GENERAL MATRIX ITS DF TFRM I NAN 1 
AND ITS INVERSF USING L-U DECOMPOSITION BY ThF 
CROUT ALGORITHM 


>!< *# *###»:# $$$*$$ »(>* $ »!!!!#*< #))t*C>t(8J!c:{C>jC$3jt *< >gc Jjc ^1 S* S* 3* # V -,! * * >y <<>!“ # If Jj< !J 


MAIN DEBUG n 1 

CHANGES 

COMMON /DRATIO/ DELETED 

DISCOS SUBROUTINE LOCATION INDEX FXTFNDFD 
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■4 


C REASON 

C UPDATED VERSION OF SUBROUTINES GAUSSI AND NUMS 

C NO LONGER NEED /DRATIO/ STORAGE AREA 

C 

C*************************************************************«********* 

c 

C SUBROUTINE MGEN DEBUG # 49 

'C CHANGES 

C REDIMENSION CODE 485 ADDED FOR /LDEBUG/ 

C 

C * * * * * 4 4 * * 4 * * * * * * * * * * * * * * * * 4 ** * * 4 * * * * * * * * * * * * # * ¥ * * 4 ¥ * * ** 4 * * * * * * * * # * * * * # * 


C 

C 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c- 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


SUBROUTINE ’MODALN(NBOD) DEBUG# 126 


CALLS 


CALLED BY 
PURPOSE 


MAIN LINE OPERATION 


UNITY 7ERO 

READ ROTTR 

WKITF 

DYNSIO 

TO SIMPLIFY THE DATA INPUT FOR FLEX I BLF BOOIFS WHEN 
THE COMBINED EFFECTS OF SPIN MAGNITUDE AND ELASTIC 
DEFORMATION ARE NEGLIGIBLE, THE USER INPUTS ONLY A 
BODY'S RIGID BODY CHARACTERISTICS, NATURAL 
FREQUENCIES* MODAL DAMPING, MOOAL AMPLITUDE AND 
SLOPE AT HINGE AND SENSOR POINTS ON BODY 


** *** 
*** DATA INPUT (ALSO SEE COMMENT CARDS IN MODALN ) **** 


CALL READ (AMU, N, N, KMU , KMU ) 

KMU * KMOOE + 6 
NE = NUMBER OF ELASTIC MODES 
N = EITHER 6 OR 6+NE 

AMU = ARRAY CONTAINING ELEMENTS OF EQUATION 11-59 

IF NO MODAL DATA OTHER THAN THE FREQUENCIES 
READ IN 6X6 RIGID BODY MASS MATRIX. 

IF MODAL DATA AVAILABLE RFAO IN ALL ELEMENTS 
OF EQUATION 11-39 (6+NE) X (6+NE) MATRIX 
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-i 


onoOr>oof' > ooooooooof' > oOoOr>r>or>ooc~,nooor>oOo£' , r>Ooc - >r)C‘'o 


AMU 


JXX -JXY -JXZ 0 

-SZ 

SY 

DX ( l ) 

• 

• 

• 

DX(NF) 

JYY -JYZ SZ 

0 

-SX 

DY ( 1 ) 

• 

• 

• 

DY(NF) 

JZZ -SY 

SX 

0 

nz< l ) 

• 

• 

t 

D/(NF I 

M 

0 

0 

AX ( 1 ) 

• 

• 

• 

AX( NF ) 


M 

0 

A Y ( I * 

• 

• 

• 

AY(NF) 



M 

AZIl) 

• 

• 

• 

AZ(NF) 

FULL SYMMETRIC 



E(l, I) 

• 

• 

• 

F ( 1 , NF ) 


MUST BE READ IN 
EITHER AXiS 
OR ( 6+NE ) X ( 6+NE ) 

E ( NE * NF ) 


CALL READ (AMU, NE, NE, KMU, KMU) 

AMU * FULL NE X NE MODAL ST I FFN p SS MATRIX 
USUALLY DIAGONAL MATRIX WITH 
OMEGA ( N ) *#2 » N=1»...»NF 
BEING DIAGONAL ELEMENTS 


CALL READ (AMU, NE, NE, KMU, KMU) 

AMU « FULL NE X NE MODAL DAMPING MATRIX 
USUALLY DIAGONAL MATRIX WITH 

?.0#ZETA*OMFGA(N), N=1,...,NE 
BEING DIAGONAL ELEMENTS 

CALL READ (AMU, 1, NE, KMU, KMU) 

AMU s 1 X NF MATRIX OF INITIAL MODAL DISPLACEMENT 
CONDITIONS 

CALL READ (AMU, 1, NF, KMU, KMU) 

AMU = 1 X NF MATRIX OF INITIAL MODAL RATF 
CONDITIONS 


HINGE POINT LOOP 

NHB = NUMBER OF HINGES ON ROny NBOD 

(EXCLUDING HINGE POINT 1 OF BODY 1) 


AIM 


0o0o^oc~>of^00o0o£ - >o0o0of , o0<->0c-i0o0'->0o0o0o0of>00o0ot^ 


on 10 11*1 * nhh 

-READ(NIT, FORMAT * 215) NOH, I TYPE 
NOH * HINGE NUMBER 

I TYPE * EULER ROTATION TYPF TO ORIENT HINGF 
TRIAD WRT BODY TRIAD 


— -READINIT, FORMAT = 3E10.3) (V(J),J=1,3) 

EULER ANGLES TO ORIENT HINGF TRIAD - PERMUTATION 
ORDER DEFINED RY I TYPE 

V(l) = THFTA 1 (FIRST ROTATION) 

V ( 2 ) = THFTA ? (SECOND ROTATION) 

V ( 3 ) * THETA 3 (THIRD ROTATION) 

READ(NIT, FORMAT = 3E10.3) ( V ( ,) ) , ,1* 1 , 3 ) 

VECTOR TO POSITION HINGE TRIAD WRT BODY TRIAD 

V ( 1 ) = X (BODY REF POINT TO HINGF POINT, BODY TRIAD) 

V ( 2 ) = Y (BODY REF POINT TO HINGF POINT, ROnY TWlAn) 

V ( 3 ) = Z (BODY REF POINT TO HINGF POINT, BODY TRIAD) 

CALL READ ( AMU, 3, NF, KMU, KMU > 

AMU = 3 X NE MATRIX OF MODAL AMPLITUDES AT HINGF POINT 

AMU ( 1 , N ) = X-COMPONENT OF MODF N AT HINGF POINT 

AMU ( 2 , N ) = Y-COMPONENT OF MODF N AT HINGF POINT 

AMU ( 3 , N ) = 7-COMPONENT OF MODF N AT HINGF POINT 

CALL READ ( AMU, 3, NE , KMU, KMU) 

AMU = 3 X NE MATRIX OF MODAL SLOPES AT HINGF POINT 

AMU(l.N) = THETA X ROTATION AT HINGF POINT FOR MO'if N 

AMU ( 2 * N ) = THETA Y ROTATION AT HINGF POINT FOR MQD C I 

AMU ( 3, N ) = THETA 7 ROTATION AT HINGF POINT FOR vnn r N 

10 CONTINUE 
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, T r rY OF TUB 

0R1G1KW' 


o o o r> o o o o o o o o n o o o o o o o o o o 


SENSOR POINT '.OOP 


c 

f. 

r 

C NSH * .,U" 'f« PP UPk't''' "I .1 . I'.'V.Y MOP 

(. 

C on PP 11*1, NSH 

(. 

C RE AD ( N l T , FORMA T = 215) NOS, I TYPE 

C 

C NOS * SENSOR POINT NUMBER 

C ITYPR = EULER ROTATION TYPE TO ORIENT SENSOR 

C TRIAD WRT BnOY TRIA" 

C 

C READIN IT, FORMAT = 3E10.3) <VU),.)=1,3) 

C 

C EULER ANOl.FS TO OR I FNT SFNSnR TRIAD - PFRMiiTATION 

C ORDER DEFINED bY ITYPF 

C 

C V(l) * THETA 1 (FIRST ROTATION) 

0 V(?) = THETA ? (SECOND ROTATION) 

V ( 3 ) = THETA 3 THIRD ROTATION) 


R“AD(NIT .FORMAT - 3E10.3) ( V ( .) ) , J * 1 . 3 ) 

VECTOR TO POSITION SFNSOR TRIAD WRT BODY TRIAD 

V ( 1 ) = X (BODY REF POINT TO SFNSOR POINT, BODY TRIAD) 

VIP) = Y (BODY R F F POINT TO SFNSOR v»i 1 1 ** T * BODY TRIAD) 

V ( 3 ) = 7 (BODY REF POINT TO SFNSOR POIIT, Bony TRIAD) 

CALL RFAOIAMU, 3, !\F, K Y|J , K Ml ' ) 

AMO i 3 X NE MATRIX OF MODAl. AMRIJTILDFS AT SEN S' 1 IM'JNI 

AMIMl.N) = X-C'.IMR'TNFNT OF Monp m AT SENSOR pnjNT 

AMl)(2,N) - Y-COMPONFNT OF MODE N AT SENSOR POINT 

A M 1 1 ( 3 , N ) = Z-COMPONENT OF MODE N AT SFNSOR POINT 


CALL READ ( AMU , 3, NE, KMU, KMIJ) 

AMU = 3 X NE MATRIX OF MOnAL SLOPES AT SENSOR POINT 
AMU(1,N) = THbTA X ROTATION AT SFNSOk POINT FOR mode n 
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^00000^0^0 -~>oooooOooooooriOoO.-^no<^of*o'~>oOriOr)<~'oOoO 


AMU(?,N) 

AM0(3,N) 


* THETA Y ROTATION AT SFNSOR POINT FOR MODF M 
« THFTA 7 ROTATION AT SENSOR POINT FOR MODE N 


20 CONTINUE 

RETURN 

ENO 

**************,<#***l»*****tt*W****l<<**Wl»lfi»iilt<*l,*>)l»>?>*W*ifil»*#Y*tt«|<W>i<V#W«>» >,<**« 

SUBROUTINE NUMS DEBUG 


CHAN GE 

UPGR ADED TO MAKE USE OF STATF OF THE ART EISPAC 
EIGENANALYSI S AND MATRIX INVERSION ROUTINES 

CALLS 

WRITE SIFT 

E I OVAL 
luinvd 

CALLED BY 

DYNS4D 

RFASON 

THE COMPUTATION OF TRANSFER FUNCTION /FROS FOR LARGE 
ORDFR SYSTEMS IS NUMERICALLY AN FXTREMFLY DIFFICULT 
PROBLEM, EVERY METHOD WHICH CAN HF IJSFD TO CONTROL 
NUMERICAL ERROR MUST HF UTIL 1 7 F D , THIS IS BEING DPMF 




SUBROUTINE ORBIT 


OFRUfi * 1?1 


CALLS 
CALLED BY 


PURPOSE 


USER DEFINED SUBROUTINE 
(NONE UNLESS USER REQUIRED) 

GRVGRD 

(ANY RFQUIRED «Y USER) 

TO OFFINF ORBITAL PAWAMFTFRS R EDU I RED TO LOCATE 
SPACECRAFT FROM A OR A V I T A T I (INAL SOURCF WRT Am 
ORBITING REFERENCE, I NFKT I ALL Y FIXEn IN POTATION 


** 

* + + 
*** 


USFR CODEING RULES ANO MODELLING CONSIDERATIONS 
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c * * 

c 

c 

f. 

c 

c 

c 

c 

c 

c 

c 

c. 

c 

r 

r 


l NO K 0 E K TO AVOID NUMERICAL COMPUT AT I ON PRDRLFMS « M 
OMB I T I MO REFERENCE FRAMF IS USED. IT IS I N F M T I A L I. y 
PIXED IN ROTATION AND FOR CONV I FNFNCF LOCATED IN The 
VICINITY OF Tu ; : SYSTEM CFNTFR OF MAS' 

SUBROUTINE UP HIT MUST DEFINE T«F FOLLOW IMS pARAmftpr.S: 

R C M A 0 = SCALAR DISTANCE FROM tup gk AV I TA T jn'gAL 

SOURCE TO THF OR 1 0 1 N OF TMF ORBITING 
REFERENCE PRAM* 

G* AG * LOCAL GRAVITATIONAL ACC F I. P P AT I ' 'N , pur AO 

PARTH OR w I T 


f 

C 

c: 


OMAN 


PARTY'S 0-R A V I T A T I i'N A I. CONSTANT 


KCMAG+w? 


C 


c 

c 


c 

c 


C. AMO I ( 1 I = X-COMPONENT of 
DIRECT ION OF 
THP ORBITING 
r, a v>, i ( ^ ) = y-rnvPOMFNT CF 
OIRECTKF OF 
THF ORBIT INC. 
GAMGim = 7-CDMP0NEOT OF 
DIRECTION PF 
THE OR I T I NO 


THF omit VECTOR IN Thp 
THF GRAVITY FIELD PRT 

rFFPRPL OF 

THF UNIT V P C T 0 w IN THP 
THP GRAVITY FIFI" 1 WRT 
rFFFRFNC.f 

THF UNIT VICTOR in- THF 
THP GRAVITY field WRT 
w FFCrpnc.F 




C 

r 


C 

c. 

c 

c 


SUBRHiM IN! UR T»'P S 
CALLS 


DEBUG « 1U 

F 1 r.PNANAI. YS I S- FISPAL 


NON F 

CAI.LFD by 

F I G A V V 
P IGVAL 

PUR ROSE 

PISPAC. ROUTINE TO RFDIICF A RPAI GFMFRAI. MATRIX TO 
UPPER HP S SF K BURG FORM USING OR T HOO>ON AL 
TkANSFI BRAT IUNS 


$«#**¥*«>* *<*¥>!< V >? V >,* *< >* w>s ¥ ¥ >H He 
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c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


SUBROUTINE ORTRAN DEBUG « 133 

F I GEN ANAL VS I S - FISPAC 


CA'.LS 
CALLED BY 
PURPOSE 


NONE 
E IGAVV 

EISPAC ROUTINE TD ACCUMUI ATE THE T« ANSFROMA T I ONS 
IN THE REDUCTION OF A REAL GFNFRAI. MATRIX BY DRThFS 


Q*#**l|l******lti*****lti*****>*******ltntl******y!ic*W>J>*W>?#«>?’i‘’t<<‘*|i>*W>t‘**WWW»»ve*SVV>l‘W 

r. 

C SUBROUTINE PLOTWR DFBUG * M 

C CHANGE 

C CALL POINT ADDFD 


C 

C 

c 

c 

c 


REASON 

TO ACCOMODATE IJSFR DESIRFD VAR IAHf.FS TO BE PI OTTFD 
MORE THAN JUST STANDARD SET OF TIM = DEPENDENT 
VARIABLES CAN NOW BE PLOTTED 




DEBUG * 1 ?3 

USER DEFINED SUBROUTINE 


C 
C 
C 
C 
C 
C 
C 

c 
c 
c 
c 


SUBROUTINE POINT 
CALLS 
CALLED BY 
PURPOSE 


(NONE UNLESS USER RFDijESTED) 
RLOTWR 


TO DEFINE ANY AUXILIARY STATE VARIABLES 
TO BE PLOTTED AS A FUNCTION OF TIME 


C 

C SUBROUTINE PRNTOU DEBUG * BO 

C 

C CHANGE 

C 1) ADD COMMON BLOCK /COMPOS/ 

C 2) CALLS TO I NVlNl DFL p TED. HFilllIREn DATA IS MOW 

C IN /COMPOS/ 

C 3) PRINT OUT C.OMPOSJTF SYSTFM CENTER OF MASS I. OCA TIP*' 

C AND INERTIA TENSOR DATA STORED IN /COMPOS/ 

C REASON 
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GOOD DATA HFNFRATFr) IN COMPiN, THIS IS PRUTI'D 
1 311 T IN THIS ROUTINE 


c 
c 
c 

C if Jjt * Xt if # DC # if X: X<X< X< X< >|< # if # s> >X * Xc v Xt if sjoni;- xt if *t X. X< Xt Xt >X Xt Xt J.; X< if w tf xt Xt Xt X- X: X: .,l Xt Xt xt Xt V Xt V : ,t V :,t;t if if j;i :< j: 

c 

SUBROUTINE PUNCH PFBIJG V 1?B 

UTII ITY ( I/P) 


NONE 

UYNS40 

Tf) PUNCH A TWO DIMENSIONAL MATPJX f’E F FA L NUMBERS 
IN A FORMAT COMPATABI.F WITH SUBROUTINE R F A D 


C 

r. 

C CALLS 

c 

C CALLFil BY 

f. 

C PURPOSE 

C 

c 
c 

c M X< X ■ Xt x< tf # xt Xt It if if Xt Xt Xt * >X X< M X< # Xt x< X< X* # * Xt Xt M * X" X< if X< Xt X= X« X< # # X< X' X< X< X< M V- w Xt if v :,t x; w xt xt xt X< :)t X> S' x= W X< » V V Xt * 

C 

C SUBROUTINE ORCON DEBUG A BS 

r. CHANOFS 

C ( 0 P L F T E 0 FROM DISCOS-?) 

C R FAS ON 

C FIOPNANALYSI S NOW DPNF VIA FISPAO RPUTIMPS 

C 

C»*XtXtX;X<»X#*itt#xt***XcXt#*ttX'*#XC9jeXiXt»-jtXc XtStXtXtXtXtXtSXtXtXtStXtwxtXfXtXtMStXcXtXtMXtXtxtxtxtxtxtXtxtxtXtiScxtxtxtxiXt 

(, 

0 SUBROUTINE 0 K D K V R DFRLIG u ha 

C. CHANGES 

C (DFLFTFD FROM DISCOS-?) 

C k FAS ON 

C EIGENANALYSIS MOW DONE VIA EISPAC ROUTINFS 

C 

c Xt Xt V X! Xt x< V * Xt if >l< Xt Xt Xt V * X< Xt Xt X< Xt X< XI Xt X< X< Xt X< X-" >:< # Xt X: Xt if Xt Xt >X W » <■ Xt * X: X> Xt * X: >y * « >,’t xt xt sit Xt Xt # s,t Xt if X! >f >f >f X. if xt Xs x> 

C 

C SUBROUTINE Ok? DEBUG A «7 

C CHANGES 

C ( D P L p T F D FROM DISCOS-?) 

C RFASON 

C EIGFNANALYSI S NOW DONE VIA FISPAC ROUTINFS 

1 

C << tf :c tf Jjt X! >X * X< >X * * X< tf X< X< * if X! Xt * Xt x< X> tf xt * tf xt x< X' tf if X> ^ xt if tf tf V V if tf « if if if if if xi if tfii.f if xt x< tf x< X> X> X< X< if if if X'- if 
C 

C SUBROUTINE RKADAM ( NEO ) DEBUG n BP 

C UTILITY NON-MATRIX OPFR. 

C CALLS 

C YOOT 
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DYNS10 


CALLED BY 


CHANGE 

COMPLETELY REWRITTEN TO 

1) ADD VARIABLE STEP INTEGRATION CAPABILITY. 

CALLED FDR RY INPUTTING A NEGATIVE MAXIMUM 
VALUE FOR STEP SIZE ( TMn AT A ( ? ) IN DYNSIO INPUT) 

2) DELETE ADAM.-, PREDICTOR CORRECTOR CAPABILITY 
(TWO FIXED STEP INTEGRATION ROUT INFS WFRF NO I 

N E E D E n ) 


THEORY 

1) IF INPUTTED INTEGRATION STEP SIZE POSITIVE 
STANDARD FOURTH ORDER FIXED STEP RUNGE KUTTA 
INTEGRATION USED 

2) IF NEGATIVE A S P E C I A L I A L L Y DEVELOPED VARIABLE 
STEP EXPLICIT, RUNGE-KUTTA ROUTINE IS USFn 


TO SOLVE 


YOT(T) = F ( T , Y ) 


LET 


Y ( T ) 

YO 

TO 

F ( T , Y ) 
YDT 


STATE AT TIME T 
INITIAL STA’F 
INITAI. TIMF 

OUTPUT OF SUBROUTINE YPOT FOR INPUT 
TIMF T AND STATF Y 
CALL YDOT ( T, Y ) = F ( T , Y ) 


DO 5 LOOP 


PI = YO 

P? = F ( TO , YO ) 


2 DO 20 LOOP; I FLAG = ? 


J I L= 1 


J IL = 2 


Y ( T0+ . 5*H ) = YO + .SYHap? 

YDT = CALL YD0T(T0+.SH ? Y0+.5*HX<P?) 

P 3 = YDT = F(T0+.5*H,Y0+. ?*H#P?) 

Y ( T 0 + H) = YO - H^P? + ?a Ha PB 
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I 

I 


c 

c 

c 

c 

c 

c 

c 

c 

c. 

c 

c 

r 

r 

r, 

(, 

L 

C. 

r 

c. 


c 


c 

c 


c 

c 

c 

c 

r. 

r 

r 

C 

C 

C 

c 

r 

c 

c 

c 


YPT = CALL YOOT ( TO+H, YO-Hw P? + •» ) 

fxit nn 20 loop 

ENTER SFCTION TU OBTAIN MFASURE OF NUMERICAL frrpr 
NOTF : 

A) SECOND ORDER FSTIMATF OF STATE AT ITO+H) ]S 

YITP+H) = YO + H#P3 + OlHftw?) 

R ) THIRD ORDER ESTIMATE OF STATF AT (TO+H) IS 

Y ( T D+H ) = YO + H#(P? + 4WP3 + YDT1/S + 0(H«*3) 

FRROK CRITERIA RASFD UPON THE ARSOMITF PERCENT PIFFiREMOr 
KF TWEEN THE SK.tlNI) AND THIRD ORf'FR INTIMATES UE dViu/iU 
S'JIPF OVER The T I v e intfrval Hs THAT IS, 

P 3 VS. ( P ? + 4$ P' 1 + YnT ) /N 

L FT : 

r = (ABSOLUTE 0 E R C F N T D I FF FR FMCE ) / 1 OD 

THFN 

H = HiSDSORT ( 0.07/F ) 

NOTE 

I PERCENT IS THF SWITCH VAI.UF C H 0 0 S F N , NUMERICAL 
EXPERIENCE HAS ESTABLISHED THAT this WORKS ' ; f= I. L 

THEN 

WITH THE RESET VALUE OF H RFTIJRN TO THF PD 20 I.Pf'P 
WITH 1 F L A 0 = 3 AND CO THROUOH 4 STANDARD FOURTH PRPFR 
KUNCE KUTTA STFP, NO ERROR CHECK TP KF MADF AFTFR 
THIS CYCLE. 

2 DO 2 0 LOOP: I FLAP = 3 

J I L = 1 

YDT = CALL YOOT ( T0+. 5H, Y0+. 5H*p? ) 

. I I L = 2 

v ' 3 = YPT 

YDT = CALL YDOT(TO+.SH,YO+.5H#P3) 

J I L= 3 

P 4 = YDT 

YPT = CALL YDOT ( TO+H, YP+HVPA ) 

FND DO 20 LOOP, HO TU 45 

.! T L = 4 


i 


A -?6 


Y( TO+u ) 


YO + H#(P? + ?*( P 3 + P 4 ) + YDT ) th + 0 (HX«« 4 ) 


C 

c 

c 

c 

c 

0 

c 

r 

c 

c 

c 

c 

c 

c 

c 

{. 

r 

0 

C 

c 

c 

c 

c 

c 

c 

c 

r. 

c 

r 


YHT = CALL vnOT(TO+H,Y<Tn+H) ) 


USER NOT?: 

1 ) C AH F WILL RFOUIRFO IV IN'FRTIMA YOIJR STANDARD 
IN-HUllSF INTEGRATION PACKAGE, THF INTFGFR • J T L • Ia 
IJSFD IN Thf GOOF AS A LOGIC - FLAG 

2 ) gUflTF GFAR, NUMF R I CA I INITIAL VAI.UF PROBLEMS TM 
C r D I AH Y Pi pFFRp\'T I AL FDUATIONS, P AGP 40 

•IN I'CMERAL IT IS DIFFICULT TO JUSTIFY THF 
ADO ! T I i'N AL WORK OF THF IMPLICIT MFTHCOS by 
thf increased accuracy attainablf, sn THF I R 
UTILITY IS RRRTR I C T c 0 TO COMP SPFCIAI PRObLFNS 
FOR WHICH THF Y HAVP DPSIRAbI F STABILITY 
C HAR.ACTFRIS TICS' 

0) MMLISTFP OR ViJI.T I VAI.IJF mpTHOOS SHOULD BP USE' 1 WITH 
FXTKFMF CAIITIPM IN A GP'.frAL PURPOSE CONTROL SYSTFM 
SIMULATION PROGRAM; m’uf 0 F T F N THAN NOT. NOF-LTNPAP 
CONTRfU SYSTEM CLEMENTS WILL CAUSF SOMF OF ThF STATE 
VARIABLES Tr Bp DISCONTINUOUS FUNCTIONS OP TIMF. FOR 
F x A vp L P LIMITPRS on THIS. SINCE THESE METHODS CAM 
h R. F A *• 0'iWF I'N SUCH Pkm.FMS THP Y SHOULO MPT BP USFO, 

■ . ) PJIPLICIT ON' RT‘ p METHODS APPEAR TO R ' THP ONLY 

I iii. )(/>[. CHOI C p FUR I N( I IJS I O’ 1 IN TH- G FAT R A I "llkPPSI 
PRi 'f.R AN . 


C S) A FT THP!' APPLICABLE TP STIFF SYSTEMS WHICH UTIII/IS 

C PART I T [uf'TNG TO I S ; ] I AT 1 ' THf SUBSET OF PTIFF' SIAIf 

C V A R I A - M F F ( ” I A T IONS WOUI.O FF DESIRABLE. IF AVAILABLE 

C CAN H.P, FRJSCH NASA/GSFC. 

C 

f BWV.i' ix J X xx xx X* Xi >X X s >X Xi Xl Xi ‘ ' i|i xi i,( x< x< l xt Xi Ji V i, >X >X -x xt V xc ’.i V x'l Xi X< -X ;x X* Xt xi 'X Xi Xi X' X ; x< xi V -I jX xx X* XX Xi X- x,i Xi ■> Xi x,c )|i XX Xf Xi X‘ ,i 


c 

f S I IBR I A 1 T INf R I ' I 1 1 1 1 OF Bl IG « 4 '• 

I, 

u change 

C WHEN ACCOUNTING FOR FLEXIBILITY IN THE nF T FR M I MA T I ON 

C. OF OR IEMTATION OF 0 AND P FRAMES WRT TH^IR BODY 

C FIXED FRAf-FS USE SUBROUT IMF ROTTRiT 
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reason 


ORIENTATION CHANGES ASSOCIATED WITH FLEXIBILITY A&F 
SMALL ANGLE, PUATERNION TECHMIOijf PF KOTTRO 
IS MORE EFFICIENT THAN Ftu.FH ANGLE T E C H M I p I ] F n F 
ROTTR, ALSO FUI.FR METHOD CAN t. «= A 0 TP ERRORS 


C 
C 

c 
c 
c 
c 

C 

C SUBROUTINE HOTOS PEBUG # 4E 

C 
C 
C 
C 
C 
C 

c 
c 
c 
c 

C »!(»}( $.#$$$ >*<c =*c sje # ^ ft### $$$$$$>}($ J* )!( 3* JJt # V V & V# # J* V V V >l'$ # ~ 3 v V. 

c 

SUBROUT I ME ROTTRO PF FUG * ||g 

MAIM LINF OPFRAT I o f 


CHANGE 


kFASON 


WHFN ACCOUNTING FOk FLEXIBILITY 
OF ORIENTATION OF SENSOR EH A M F S 
FRAMES USF ROTTRP 


IN THF DFTEH 'IMaTION 
wrt the Hfinv «- 1 x t- r> 


OUATFRMIPN TECHNIPUE IS MORF EFFICIENT THA* 
TECHNIPIIF PUE TO SMAI L ANGI. c FI.ASTIC n F F 0 R ■ 
ALSO Fill. FR METHOD CAN l.fAD TP s^oRS 


u t * I. F i< 
AT T ; ia- 


( NONE ) 

HOT PEI 
OTPS 

TO USF EULER PAH AMF TER (PUAT c kNinM) 
COMPUTE TRANSFORMATION MATRIX 


TECh'I If'li'- TO 


C 

c 

C CALLS 

C 

C CALLED BY 

C 
C 

C PURPOSE 

C 

c 

C HF A SI IN 

C 

c 
c 
c 
c 
c 
0 
c 

C ^ 3jc * # x 3<i sit Y A lE $ V £ # 3N 3* # Xc s{: gt ** gc *;• £ V & 3|t *:« 3,< J.e :>■ V £.‘ -,£ 3,'; J»: V V 3jc V : i : 3;c :,<■ V * £ 

C 

C SUBROUTINE SE T I DEBUG ** ] ?? 

C USF>- P c F I UFP SUBROUTINE 

C CALLS 


HEFEHFMCF FPAMF ORIENTATir’M Changes ASSOCIAT'D ' ! In 
BODY FLEXIBILITY ARF SMALL, 0 1 1 A T F R N | p tv TFC.HN I ■"•II F 
IS COMPUTATIONALLY MORE effICIFNT THAN FH!'-*' A^GLi 
TFCHNIOUF USFP ORIGINALLY IN PISCOS. ALSO FUI.FR 
TFCHNIPIIF CAN LFAP TO FHHPHS SIMfP ORIENTATION 
CHANGE MEASURED IN PIRFf.TIUN CnSJNFS *PT Fljf.F.i 
ANGLES 
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CALLED BV 

PURPOSE 

REASON 


< NONE UNLESS USER REQUESTED) 

YDOT 

TO IMPLEMENT HMILATFRAL CONSTRAINT SPECIFICATIONS 

THE EXISTANCE OF PARTICULAR CONSTRAINTS AT H I NR F 
PC. NTS (DEFINED VIA IHDATA ARRAY) CANNOT ALWAYS b F 
TAKEN AS TIME INDEPENDENT 


FOR EXAMPLE: THE SIMULATION HF STICTION (SLIDING 
FRICTION). SPACECRAFT APPENDAGE DEPLOYMENT Through 
LOCK-UP, SPR ING-DASHPOT SYSTEMS WITH STOPS, ETC 
ALL REQUIRE THAT THE EX I STANCF OF A CONSTRAINT BE 
DETERMINED VIA A FUNCTION OF TIME AMD SYSTEM STATF. 


*** USER CODEING RULES AND MODELLING CONSIDERATIONS 


IN SUBROUTINE DYNSIO ALL CONSTRAINT CONDITIONS AT ALL 
HINGE POINTS ARE USER DEFINED VIA INPUT DATA 

SUBROUTINE SFTI CAN BE USED TO EFFECTIVELY OVER-RIDE 
THE DATA LOADED IMTO THE IHDATA ARRAY 

METHOD 

1) REFFR TO SUBROUTINE DFF3 * nYNSlO INPUT 

MODIFY DEFINITION OF IHDATA INTFGER ARPAY 

I HDATA ( 2-7 » J ) = 2 RHEONOMIC CONSTRAINT AT TIME 

;FRO OR SOMTTMT t.ATFR 

ANY CONSTRAINT CONOITION Sl|«JFCT TM CHAM.: 
VIA SUBROUTINE SFTI IS TYPE 2 

2) IN SUBROUTINE YDOT, FIRST PASS Through <>LI. NLAM 
ELFMENTS OF IRH ARRAY SFT TO 1 

DO ? 1=1, NLAM 

? irh( i ) = i 

3) RECALL ALL LAGRANGE MULTIPLIERS (FORCES AND 
TORQUES OF CONSTAINT) ARF CONSECUTIVELY 
NUMBERED! 
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■ n 


v 




I V ( I . L ) * 0 IF PFORFF OF FRF FPOM I,I=i,..,A 
AT HINOF POINT L ALWAYS FR F c f >F 
CONSTRAINT 

= NIJMRFR ASSIGNED TO t.AOwAMO- 

Mlll.T I PL I = R A S SOf. I AT p 0 WITH Tf-f 
FIXFH OR RHFNOMIC CONSTRAINT 
WHICH IS OR WILL R F ApPITFI) Tn 
OFGRFF OF FREEDOM 1,1=1,....* 

AT HINCF POINT L 

IV STORFO IN 
•/I VCONS/ 

A) CONSIDER DECREE OF FREFnOM I AT HIKF pnpn L 
WHICH WILL AT SOMP TIMF »F SURJFCT TO FITHIR 
A FIXED DR RHFON I N I C CONSTRAINT 


PRO V IDF THF LOGIC TO DFFINP whpthFR no - nr 
THF DFCRFF OF FREFDOM is FRPP 

SET 

IKHIIVfl.L)) = h if DFCPFC OF ERF'Dim I 

AT HINCF POINT I. I N FPFF 

IRH( IV( I.U ) = 1 IF ncCRFF OF c k p F DOM I 
AT HIN«c POP T I. IS 
F-IX = n 0“ k M r O v : ii‘ J CA 1.1- Y 
CON RTP A I N F n 

THF LOGIC USED TO SET AND M>-SCT THF r :!.F'FNTS OF 
I K H MAY PF A FUNCTION OF TP’F ANn M- Y S^T ' F 
SYSTEM STATE VARIABLES. 

5?‘/SAVALN'/ CONTAINS ALAMS, ARRAY OF 

ESTIMATES OF WHAT T^F FUWCFS AND T OR ( 'T I F S OF 
CONSTRAINT WII.I HE AT T Hr Pin nF P'l 
I NTFGR AT I ON STEP. Tuf Sr f AN k>- USE P: pu I CMC 
Til DFTFRMINF COMSTAINT CONDITIONS FOR Uix| Silk 

ft) MAKF SURF THAT ALL CO'''STR I ANT S v-hJCm ChN rtf 

AFFECTED RY SFTI A R F OF T Y P P ? ( RHFPNOM I C ) 

THIS IS REOUIRFD RY COMPUTATION IPGIC. I f Nr 1 I 
THFN FITHFR RFI.ATIVF POSIT: ■'N UR I.ACWAMCF 
C MULTIPLIFR WILL NOT RF CALCULATED 
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+m*+*+********++++***+m*v****+#+*++**v***+* + *****+»*v#*+**+*<t>>»#m***v**v 


SUBROUTINE SFRE02 DEBUG * 73 

CHANGES 

REDIMENSION CODF A85 ADDFD FOR /I. DEBUG/ 

mm + +++****ii**m++*** + ***#*****v i i“t‘*v****m**vi<“)‘’i‘*‘fm*vvv##mv>*Mi<tv#**‘*<>t‘’t>:tv*n 

SUBROUTINE START DEBUG * 6 

CHANGES 

REOfMENSION CCIOF ABB ADDFD FOR /I.DFbiig/ 

RED I MENSI ON CODF ABB ADDFD TO FIX LIMIT ON DO LOOP 
READ STATEMENT FOR DEBUG FLAGS FIXED 

REFER TO 

OEF3 DEFINITION OF START INPUT DATA RFAO STATFMFN1S 
SECOND R F AD STATE MFt>T« MOW 

R F AD ( N I T * FORMAT ■ 601.1) DF'UIG 

REASON 

SI7E OF DEBUG ARRAY HAD TO BF FMI.ARGFD FOR DISC'S-^ 


subroutine subdia debug * hh 

CHANGES 

(DELETED FROM DISCOS-2) 

RFASON 

p IGFNANALYSI 5 NOW DONE VIA FISPAC ROUTINES 




SIJBRUUT INE TFTYPE DEBUG W 67 

CHANGES 


REDIMENSION CODE AB5 ADDFD FOR /LDFBIIG/ 


SUBROUTINE TORUUE DEBUG # 57 

CHANGES 

REDIMENSION CODE AB5 ADDFO FOR /I. DF BUG / 

Q******i|<i|<**>t^**>l<******$**>*4#i|'tt##**>»*jM** ft******* >.'<>!<>:< 9 >;< ¥*<>:<«$ 

C 
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c 

r UflR(IUT INE 

TTEF 

PFRUO * ST 

c 

CHANOFS 



c 


REDIMFNSION 

CODE 4RS A DDF n FOR /l.nFRUO/ 


r. 




c 

c 

c 

r 

c 

c 

C 

c 

c 

(. 

(. 

c 

c 


SUBROUTINE 

YOOT 

DFRUC 

; * 39 


CALLS 

WRITES 

ROTDH 

rhoenr 

MAIN LINF DPERATIO'i 
RDTDS 


BSOENR 

MNFN 

COMPJN 

F INDII 


MULT 3 

OR VORD 

nLMRRT 

INV1NP 


c,E Trmr 

SFTI 

DCOM? 

ADT 

CALLFD 

HAKSLV 

BY 

DYNSPO 

RKADAM 

LINFAR 

TOROUE 

RDPTOP 



PURPOSF 


r. 

r. 

r 


(SAMP AS IN niscns) TO COMPUTE THP F I R R T TIME 
DERIVATIVE OF THE STATE VFCT<'R Y 

CHANGES 


C 

C 

C 

C 

c 

c 


MODIFIED TO USF I MPtll. S F / YOMFMTl IN CfV'n J T J -'N s T D 
MAINTAIN THE PR F SCR IP FI) CONSTRAINT CrnniTIONi 

RFASflN 

NUMERICAL ERRORS WHFRP EXOEFniNo toi.pram.p LIMITS 
FOR C p RT I AN SIMULATIONS, A METHOD TO iVFRCDMt Tuts 
DEFICIENCY HAO TO «F DFVF LOPED 

THFORY 


C 

C 

r 

L 

r, 

c 


EOk SIMULATION PI IR PC'S F S numerical FRRPW can rtF 
VIEWED AS AN IMPLUSF, THF N C T FFFFCT OF Thi r-WR''R 
INPLUSF IS TO CAUSE A'' ASSnC,IAT r -U EwRltR I " Tuf 
COMPUTATION OE IMf ORDINARY MOMINTA AMO SYSM 1 ’ . I A I ( 

THIS ERROR CAN RE DETERMINED my 1 1 T 1 1 I / A T I Of mE Imp 
CONSTRAINT f'HlATIONS: ONCE KNOWN IT C AN nP 
REAPPLIED TO ARRIVE AT THE TRUE VAI.IIC FOR CMRRE'iT 
SYSTFM STATE AND ORDINARY MOMENTA 


C 

C 

l 

c 

c 


LET 

P(-) ORDINARY m C M F M T A AS COMPUTED WITH 
NUMERICAL error 

U ( - ) SYSTEM STATE AS COMPUTED WITH 
NUMERICAL ERROR 

EE ERROR IMPULSE MULTIPLIERS (TO hF FOUND) 
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P( + ) CORRECT VALUF OF ORDINARY MOMFNTA 

U( + ) CORRFCT VALUE OF SYSTEM STATE 

H KINEMATIC r.npFF I C 1 ENT MATRIX, SAMP AS 

THAT USED If. EQUATION I I~1 
F**T TRANSPOSE OF MATRIX B 

H**T*EF ACTUAL ERROR IMPLUSE TO HF APPLtPQ TO 
COMPENSATE FOR NUMERICAL ERROR 
M MASS MATRIX AS USF IN FIJI' AT ION I I -1 


UTILIZING THESE DEFINITIONS THF CORRECT VALUF FOR 
ORDINARY MOMENTA IS 

P( + > x P(-) + r*#tmmfp ( 1 | 

FROM EQUATION I I -A9 

P ( +OR- I = MmU ( +OR - ) (?) 

THEREFORE BY DIRECT SUBSTITUTION OF (?) INTO (I) 

U ( + ) = (J(-) + M**( -1 )#r#*t*EF (?) 

UTILIZE THE CONSTRAINT EQUATION JI-S 

BMU ( + ) = ADT (A) 


WHERE 

APT PRESCRIBED VELOCITIES: FITHER 7FRO FOR 

FIXEn CONSTRAINTS OR IlSFR OFF I N F 0 FOR 
RHEONOM I C, CONSTRAINTS 

SUHSTITUE (?) INTO (4) AMO SOI VF FOR FF TO Oh TAP' 

FF * (B*M**(-1 I*Hx>mT)mv(-I )m( ADT - Hvm(-) ) ( S ) 

USE THIS ERROR IMPUI.SF MULTIPIPR (COMPUTED H ynr T 
BETWFEN DO 1«D AND PROGRAM Pf'IMT jan*) TO CompiiTF 
THE CORRECTED VALUES OF ORDINARY MOMFNTA Aon SyST'-m 

STATF: that is, in the no inn i.onp 

P(+) r P(-) + h'i'KTMFF (A) 

U ( + ) = U(-) + -) P'PE (7) 

IS EVALUATED AND CARRIFD thru all subsequent 
CALCULATIONS. 


i 


t 
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this PK'ir.FeniiHP i s only carrifh riitT ftp ■■jon-ms 

TIMfc nON'AIN ANALYSIS. I F ( I FI Vl F* . F 1 1. ■ > ) SKJP IT 

c 

f. FHTHPKMflrtF 

c 

C YOOT NOV/ CALLS SOAR 'Jl IT I w- To I'ft-l i F,i«r 

C I N F K T I A WHICH MUST I * TR.'iniC.tn If AN ACf-M'P/i 

( fwanf OF RFFIRFACF is Tn Uf M s •- r* 

r 

C CALL m c CJMM I M .AOnpr, NCIW C>"*P(isirf nvst-* st,. t 

C CO’-'PllTFP AT ENn (IF EACH ! T TF'-P AT I n N STFP 

C 

C CALI. Tn FI NOLI NOT M AD F F A C H 1 MT F,,k AT I T l CyCI.f ' 

C FLIPPING fpup o\f Tn asothfr sfj of p.fspr*,f'r-s,i 

C OF r,k F F S OF FkFFHIV AVInOin, ACCu-ACY ^ im F“ S' 

C PHYSICAL I \ T FPk F TAT I 11V OF W F si II T s TAPAMlI.IlY 

L INHANC F!) 

L 

C vtfi/iif t:* #*#&#### uyntv v-t.t.f.r *.**#!/ tttfu* xvi. tfu 

C 

kFTUxN 

fno 


I u * 

f S f’F 
II"- 

■n- . 

I I 

CS W S xt sc 
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